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Abstract 

This  paper  presents  a  Lie  group  setting  for  the  problem  of  control  of  formations, 
as  a  natural  outcome  of  the  analysis  of  a  planar  two-vehicle  formation  control  law. 
The  vehicle  trajectories  are  described  using  planar  Frenet-Serret  equations  of  mo¬ 
tion,  which  capture  the  evolution  of  both  the  vehicle  position  and  orientation  for 
unit-speed  motion  subject  to  curvature  (steering)  control.  The  set  of  all  possible 
(relative)  equilibria  for  arbitrary  G-invariant  curvature  controls  is  described  (where 
G  =  SE(2)  is  a  symmetry  group  for  the  control  law).  A  generalization  of  the  con¬ 
trol  law  for  n  vehicles  is  presented,  and  the  corresponding  (relative)  equilibria  are 
characterized.  Work  is  on-going  to  discover  stability  and  convergence  results  for  the 
n-vehicle  problem.  The  practical  motivation  for  this  work  is  the  problem  of  forma¬ 
tion  control  for  meter-scale  UAVs;  therefore,  an  implementation  approach  consistent 
with  UAV  payload  constraints  is  also  discussed. 
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1  Introduction 


As  the  technological  development  of  meter-scale  UAVs  (unmanned  aerial  ve- 
hices)  progresses,  and  the  cost  of  such  vehicles  decreases,  there  is  growing 
interest  in  applications  for  formations  (or  swarms)  of  these  UAVs.  These  ap¬ 
plications  include  surveillance,  creating  decoys,  delivery  of  payloads  (e.g.,  dis¬ 
tributing  ground-based  sensor  networks),  and  radar  or  communications  jam¬ 
ming.  Having  human  operators  remotely  control  each  UAV  in  a  formation 
is  impractical;  therefore,  coordinating  the  flight  of  multiple  UAVs  becomes  a 
problem  of  automatic  control.  In  ongoing  work,  we  are  examining  a  particular 
approach  to  this  control  problem,  with  the  ultimate  objective  of  producing  a 
prototype  system  capable  of  meeting  the  size,  weight,  and  power  constraints 
associated  with  small  UAV  platforms. 

An  essential  feature  of  the  formation  control  problem  for  meter-scale  UAVs 
is  that  “autonomy”  (e.g.,  sensors  and  processing  power  for  target  recognition, 
obstacle  avoidance,  GPS  and  inertial  navigation,  and  performance  of  sophis¬ 
ticated  mission  objectives)  is  severly  limited  by  cost  and  payload  constraints. 
Consequently,  we  identify  a  few  specific  objectives,  and  attempt  to  formulate 
and  implement  a  control  law  to  meet  these  basic  objectives.  These  objectives 
are  to  avoid  collisions  between  UAVs,  maintain  the  cohesiveness  of  the  forma¬ 
tion,  be  robust  to  loss  of  individuals,  and  scale  favorably  for  large  swarms.  The 
challenge  is  that  the  physics  of  sensing,  actuation,  and  communication  can¬ 
not  be  neatly  separated  from  the  problem  of  coordination  and  control.  Rather 
than  simply  extra  payload,  the  automatic  control  system  for  formation  control 
becomes  an  integral  part  of  vehicle  design. 

In  section  2,  we  describe  how  an  automatic  control  system  for  formation  flying 
could  be  practically  implemented.  The  basic  idea  involves  providing  a  mecha¬ 
nism  (based  on  radio-frequency  pulses)  by  which  each  UAV  can  sense  its  range 
and  relative  orientation  with  respect  to  its  neighbors.  We  consider  simple  rules 
for  how  each  UAV  changes  its  motion  in  response  to  these  “sensor”  measure¬ 
ments.  In  terms  of  implementation,  the  hardware  required  for  the  controller 
on-board  each  UAV  can,  by  incorporating  analog  VLSI  circuitry,  fit  on  a  single 
small  printed-circuit  board.  The  objective  is  to  supply  the  collection  of  UAVs 
with  a  “default”  formation-maintaining  behavior  in  such  a  way  that  the  for¬ 
mation  (as  an  entity)  can  be  easily  controlled,  e.g.,  by  modifying  parameters, 
adding  exogenous  inputs,  or  switching  among  various  “default”  behaviors. 

Models  of  the  individual  vehicles  are  based  on  the  planar  Frenet-Serret  equa¬ 
tions  of  motion  (discussed  in  section  3),  which  describe  how  vehicle  trajectories 
evolve  under  curvature  (steering)  control,  subject  to  a  unit-speed  assumption 
[1].  While  our  interest  is  primarily  in  formation  control  for  small  UAVs,  this 
approach  to  modeling  and  control  could  also  be  applicable  to  formations  or 
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swarms  of  ground  vehicles  or  underwater  vehicles,  and  may  also  be  a  useful 
starting  point  for  understanding  certain  features  of  biological  swarming  or 
schooling  behavior. 

This  paper  presents  a  Lie  group  setting  for  the  problem  of  control  of  for¬ 
mations.  The  setting  emerges  naturally  from  the  analysis  of  basic  cases  and 
concomitant  physical  contraints  on  the  controls.  (A  modern  reference  for  con¬ 
trol  systems  on  Lie  groups  is  Jurdjevic  [2].) 

The  primary  analytical  result  we  present  (in  section  4)  is  a  global  convergence 
result  for  a  planar  two-vehicle  formation  control  law,  proved  using  LaSalle’s 
Invariance  Principle  [3].  A  corresponding  convergence  result  for  a  single  vehicle 
responding  to  an  omnidirectional  beacon  is  also  presented,  and  is  used  (in 
section  5)  to  help  physically  motivate  the  form  of  the  two-vehicle  control  law, 
and  to  explain  the  relationship  between  the  various  sensor  measurements  and 
the  quantities  appearing  in  the  control  law.  A  generalization  of  the  control  law 
to  n  vehicles  is  presented  in  section  6,  but  a  stability  analysis  is  the  subject 
of  on-going  work,  and  will  be  presented  in  a  future  paper. 

The  two- vehicle  control  law  has  an  evident  Lie-group  structure,  and  this  struc¬ 
ture  is  exploited  (in  section  7)  to  determine  the  set  of  all  possible  (relative) 
equilibria  for  arbitrary  G'-invariant  curvature  controls,  where  G  =  SE( 2)  is 
the  symmetry  group  for  the  control  law.  Ideas  of  “shape  control”  on  Lie  groups 
arise  in  a  natural  way  for  this  problem  [4-6].  The  equilibrium  analysis  is  also 
generalized  to  the  n- vehicle  problem.  Finally,  in  section  8,  we  discuss  directions 
for  future  research. 

The  use  of  curvature  controls  can  be  given  the  mechanical  interpretation  of 
steering  unit-mass,  unit-charge  particles  by  magnetic  fields  (and  hence  by 
forces  derived  from  vector  potentials).  For  a  discussion  of  the  general  theory 
of  such  controls,  see  [7].  This  is  in  contrast  with  other  current  approaches  to 
formation  control  that  are  based  on  scalar  potentials  [8].  Furthermore,  our 
emphasis  on  the  Lie  group  structure  of  the  control  laws  distinguishes  our 
work  from  an  established  physics  literature  in  the  area  of  large  collections 
of  interacting  particles  subject  to  local  interaction  laws,  and  giving  rise  to 
pattern- forming  systems,  spatially  localized  coherent  structures  (e.g.,  flocks), 
and  phase  transitions  (e.g.,  from  disorder  to  order);  see,  for  instance,  [9-11]. 
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Receiver  output 


Fig.  1.  A  pair  of  receive  antennas  separated  by  a  quarter- wavelength,  and  the  sinu¬ 
soidal  function  of  angle-of-arrival  which  it  can  measure. 

2  Formation  control  system  implementation 

2.1  Angle-of-arrival  and  range  sensing 


Consider  the  planar  formation  control  problem:  i.e.,  assume  that  there  as  a 
common  plane  of  motion  for  the  UAVs  (and  that  this  plane  of  motion  does  not 
change  with  time).  Suppose  that  an  RF  (radio-frequency)  transmit  antenna, 
as  well  as  a  pair  of  receive  antennas,  are  located  in  (and  oriented  perpendicular 
to)  the  plane  of  motion.  (Neglect  the  mutual  impedance  of  the  receive  anten¬ 
nas).  If  the  receive  antennas  are  spaced  a  quarter- wavelength  apart,  then  by 
appropriate  quadrature  phase  shifting,  correlation  (i.e.,  multiplication),  and 
low-pass  filtering,  a  sinusoidal  function  of  the  angle  of  arrival  can  be  measured 
(see  figure  1).  The  range,  or  distance  between  the  transmitter  and  receiver,  can 
also  be  measured  (since  it  is  inversely  related  to  the  received  signal  power). 

If  two  pairs  of  receive  antennas  are  used,  oriented  perpendicular  to  each  other 
as  shown  in  figure  2,  then  the  direction  of  arrival  of  the  received  RF  signal 
can  be  unambiguously  determined.  (Although  dipole  antennas  are  shown  in 
figure  2,  the  actual  antenna  design  would  need  to  take  into  account  aircraft 
aerodynamics  and  possible  parasitic  antenna  elements.  Noise,  interference,  and 
multipath  are  also  important  electromagnetics  issues,  but  are  also  beyond  the 
scope  of  this  paper.)  As  figure  2  suggests,  the  antenna  separation  and  hence 
the  transmission  frequency  are  related  to  the  UAV  dimensions. 

It  turns  out  that  more  information  besides  simply  range  and  direction-of- 
arrival  is  useful  for  formation  control.  Specifically,  we  would  also  like  to  sense 
the  relative  orientation  between  the  transmitting  and  receiving  UAV.  This 
extra  information  can  be  sensed  if  all  four  antennas  shown  in  figure  2  partic¬ 
ipate  in  transmitting  as  well  as  receiving.  Each  pair  of  antennas,  considered 
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Fig.  2.  Two  pairs  of  receive  antennas  oriented  perpendicularly  on  a  UAV. 

as  a  transmitting  antenna  array,  has  a  cardioid  antenna  pattern  if  driven  with 
single-tone  pulses  which  are  in  phase-quadrature  (figure  3(a)).  Reversing  the 
signals  to  the  two  antennas  spatially  reorients  the  cardioid  antenna  pattern 
by  180  degrees  (figure  3(b)).  If  two  quadrature  signals  at  nearby  but  different 
frequencies  are  fed  to  the  antennas  simultaneously,  but  with  the  proper  phase 
relationship  so  that  the  cardioid  antenna  patterns  have  their  peaks  in  oppo¬ 
site  directions,  then  by  differencing  the  (normalized)  amplitudes  (i.e.,  power 
measurements)  of  the  received  pulses,  a  remote  UAV  can  extract  information 
about  the  orientation  of  the  transmitting  UAV  relative  to  the  baseline  be¬ 
tween  the  two  UAVs  (figure  3(c)).  If  both  pairs  of  half-wave  dipole  antennas 
are  driven  (with  four  nearby  but  different  frequencies)  in  this  way  (figure  3(d)), 
then  the  remote  UAV  will  have  enough  sensor  information  to  unambiguously 
measure  the  mutual  orientation  of  the  two  UAVs. 

After  presenting  and  analyzing  a  specific  control  law  in  sections  3  and  4,  we 
will  explicitly  show  (in  section  5)  how  the  various  quantities  in  the  control  law 
correspond  to  relative  orientation  and  range  measurements  of  the  type  just 
described. 


2.2  Pulsed  communication  scheme 


In  the  previous  subsection,  we  discussed  how  RF  signals  and  appropriate  an¬ 
tenna  configurations  can  permit  each  UAV  to  sense  range  and  orientation 
relative  to  the  other  UAVs.  One  approach  for  reducing  power  consumption 
while  keeping  the  system  complexity  low  is  to  transmit  RF  pulses,  as  shown 
in  figure  4,  rather  than  continuous-wave  signals.  The  UAVs  take  turns  trans¬ 
mitting  pulses  (or  bursts),  and  except  when  transmitting,  each  UAV  listens  to 
the  others.  (Of  course,  some  scheme  is  required  to  organize  the  pulsed  commu¬ 
nication  and  prevent  simultaneous  transmissions,  but  these  details  are  beyond 
the  scope  of  this  paper.)  The  PRI  (pulse  repetition  interval),  pulse  width,  and 
power  consumption  depend  on  the  frequency,  the  number  of  UAVs,  and  the 
required  UAV  control  signal  update  rate.  Thus,  the  communication  system 
depends  intimately  upon  vehicle  characteristics,  such  as  its  dimensions  and 
dynamical  constraints. 
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Fig.  3.  Using  two  pairs  of  antennas  for  extracting  relative  orientation  information: 
(a)  cardioid  antenna  pattern  for  a  single  pair  of  antennas  and  a  single  tone;  (b) 
cardioid  antenna  patterns  for  a  single  pair  of  antennas  and  two  tones  at  different 
frequencies;  (c)  difference  in  received  signal  power  as  a  function  of  angle  between 
the  transmitting  UAV  and  the  baseline;  and  (d)  cardioid  antenna  patterns  for  two 
pairs  of  antennas  and  tones  at  four  different  frequencies. 

Using  this  type  of  pulsed  communication  system  avoids  the  need  for  a  data 
communication  network  for  formation  control.  (Of  course,  if  a  data  communi¬ 
cation  network  were  available,  the  UAVs  could  determine  their  own  positions 
and  orientations  using  GPS,  and  then  exchange  the  information  with  each 
other  over  the  data  communication  network.)  The  main  drawback  with  using 
a  data  communication  network  is  the  interplay  between  the  communications 
and  the  control  aspects  of  the  resulting  communicating  networked  control  sys¬ 
tem.  (Note,  for  example,  that  as  the  UAVs  move,  the  network  topology  may 
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Fig.  4.  Pulsed  communication  system:  the  UAVs  take  turns  transmitting  pulses,  and 
except  when  transmitting,  each  UAV  listens  to  the  others. 

change.)  Using  a  data  communication  network  for  control  requires  careful  at¬ 
tention  to  communication  protocols,  can  introduce  problems  of  scalability  for 
large  formations,  and  can  be  extremely  difficult  to  analyze.  An  additional 
benefit  of  the  pulsed  communication  scheme  is  reduced  reliance  on  GPS. 

The  pulsed  communication  scheme  uses  time-division-multiplexing  to  share 
the  communications  bandwidth  among  multiple  transmitters.  One  reason  for 
chosing  this  scheme  is  to  facilitate  prototyping.  Of  course,  other  channel- 
sharing  techniques  like  CDMA  (code  division  multiple  access)  might  ulti¬ 
mately  be  useful  for  improving  stealth  capability  and  reducing  succeptibility 
to  jamming. 


2.3  Transceiver/controller  block  diagram 


Figure  5  shows  the  block  diagram  for  a  transceiver /controller  capable  of  imple¬ 
menting  the  control  systems  we  consider  based  on  the  pulsed  communication 
scheme  described  in  the  previous  subsection.  The  four  antennas  represent  the 
two  pairs  of  antennas  in  figure  2.  When  the  UAV  is  listening,  the  antenna 
signals  pass  through  the  transmit /receive  switches  to  the  low-noise-amplifiers 
and  bandpass  filters.  Next,  the  signals  arrive  at  an  analog  processor,  which 
produces  the  various  range  and  orientation  measurements  described  above, 
and  combines  them  into  a  single  steering  control  increment  each  time  an  RF 
pulse  is  received.  This  steering  control  increment  is  then  digitized  and  sent  to 
a  digital  processor.  The  analog  processor  also  has  an  output  signal  (an  activity 
indicator)  to  tell  the  digital  processor  whether  its  steering  control  increment 
represents  valid  data.  The  digital  processor  accumulates  the  steering  control 
increments  over  a  full  period  during  which  each  other  UAV  is  transmitting, 
and  then  updates  a  steering  control  signal  that  it  sends  to  the  UAV  autopi¬ 
lot.  The  digital  processor  is  also  responsible  for  controlling  when  the  UAV 
transmits,  and  when  it  listens.  During  the  transmitting  phase,  the  required 
quadrature  oscillator  signals  (which  can  be  generated  by  the  analog  processor) 
are  amplified,  and  sent  to  the  antennas  through  the  transmit /receive  switches. 
The  digital  processor  can  also  have  a  control  line  to  the  analog  processor,  so 
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Fig.  5.  Transceiver/controller  block  diagram  for  UAV  control  based  on  pulsed  com¬ 
munication. 

that,  e.g.,  control  law  parameters  can  be  varied  on  the  fly. 

The  digital  processor  is  thus  involved  with  organizing  the  pulsed  communi¬ 
cation,  interfacing  with  the  autopilot,  and  could  also  potentially  filter  (or  re¬ 
ject  corrupted  data  from)  the  analog  processor  signal.  Although  not  indicated 
in  figure  5,  the  digital  processor  can  also  interface  with  a  higher- level  con¬ 
trol  system  on  board  the  UAV,  which  may  communicate  with  the  ground  or 
other  UAVs  using  a  data  communication  network.  Such  data  communication 
could  be  used  to  control  the  formation  as  a  whole,  with  the  basic  formation- 
maintaining  function  being  performed  by  the  pulsed  communication  system 
and  block  diagram  of  figure  5. 

The  key  feature  of  figure  5  is  that  (apart  from  the  antennas  and  autopilot) 
the  entire  system  could  potentially  fit  on  a  single  printed  circuit  board  small 
enough  to  fit  into  a  meter-scale  UAV,  provided  the  analog  processor  is  im¬ 
plemented  using  analog  VLSI  technology.  There  are  some  similarities  between 
the  analog  processor  in  figure  5  and  the  analog  CMOS  continuous  wavelet 
transform  circuits  developed  at  the  Naval  Research  Laboratory  [12],  There  is 
thus  a  feasibility  demonstration  of  some  of  the  required  subcomponents  of  an 
analog  VLSI  processor  for  the  UAV  formation  control  application. 

The  possibility  of  producing  a  practical  prototype  formation  controller  for 
meter-scale  UAVs  is  precisely  what  motivates  the  modeling  and  analysis  pre¬ 
sented  in  the  following  sections  (although  building  such  a  prototype  controller 
would  still  be  a  project  in  its  own  right).  However,  the  modeling  and  anal¬ 
ysis  might  be  useful  for  other  formation  control  problems  as  well  (e.g.,  for 
ground  or  underwater  vehicles).  As  long  as  the  required  range  and  orientation 
quantities  can  be  measured  and  communicated  to  the  appropriate  vehicles, 


Fig.  6.  UAV  trajectory  illustrating  definitions  of  x,  y,  z,  and  r. 


the  control  laws  we  present  may  be  useful. 


3  Modeling  UAV  formations 


Each  UAV  trajectory  is  given  a  kinematic  description  using  (a  variant  of)  the 
well-known  Frenet-Serret  equations  of  motion,  where  at  each  point  along  the 
trajectory  one  attaches  a  moving  frame  (of  unit  tangent,  normal,  and  binormal 
vectors)  [1].  For  a  single  UAV,  the  evolution  equation  we  consider  is 


r  =  x 

x  —  yu  —  zv  (1) 

y  =  —xu  +  zw 
z  =  xv  —  yw, 


where  r  is  the  position  of  the  UAV;  x,  y,  and  z  are  orthonormal  vectors 
specifying  the  orientation  of  the  UAV;  and  u,  v,  and  w  are  scalar  control 
inputs  (any  two  of  which  are  sufficient  to  specify  the  motion).  As  shown  in 
figure  6,  x  specifies  the  unit  tangent  vector  to  the  UAV  trajectory,  y  is  normal 
to  the  trajectory,  and  z  (the  binomial)  completes  the  orthonormal  frame. 

Using  a  kinematic  description  of  the  motion  allows  us  to  consider  the  forma¬ 
tion  control  laws  independently  of  the  dynamics  of  individual  vehicles.  The 
formation  control  laws  we  consider  would  be  implemented  as  simple  commands 
supplied  to  each  UAV’s  on-board  autopilot,  which  has  already  been  designed 
to  account  for  the  vehicle  dynamics.  Although  optimal  energy  use  is  an  im- 
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portant  criterion  for  UAVs,  our  philosophy  is  to  try  to  provide  near-optimal 
energy  use  in  the  UAVs  by  studying  optimality  criteria  within  the  frame¬ 
work  of  our  kinematic  models.  At  this  stage  in  our  investigations,  however, 
we  are  simply  trying  to  demonstrate  models  with  basic  formation-maintaining 
behaviour. 


Note  that  the  Frenet-Serret  frame  for  the  UAV  corresponds  to  the  trajectory 
followed  by  the  UAV,  not  to  the  orientation  of  the  UAV  itself.  For  example,  an 
aircraft  would  normally  change  direction  by  banking  (rather  than  by  yawing, 
as  would  be  required  if  the  Frenet-Serret  frame  described  its  orientation).  For 
purposes  of  the  idealized  control  laws  we  present,  the  Frenet-Serret  frame  is 
the  one  that  applies.  (The  UAV-fixed  frame  could  play  an  important  role, 
however,  in  the  control  system  implementation  based  on  pairs  of  antennas 
and  pulsed  communication,  an  issue  which  merits  further  investigation.) 


To  reduce  from  a  three-dimensional  Frenet-Serret  model  to  a  planar  model, 
we  simply  set  the  controls  v  and  w  to  zero  in  equation  (1),  which  eliminates 
the  dynamical  equation  for  z.  In  this  case,  it  is  assumed  that  each  UAV  has 
some  alternative  method  of  determing  the  appropriate  altitude.  We  allow  for 
the  possibility  that  the  UAVs  are  flying  at  the  same  altitude,  so  that  collision 
avoidance  is  a  consideration. 


4  Planar  control  law  analysis 


4- 1  Control  law  for  a  pair  of  vehicles 


Consider  two  vehicles  modeled  as  point  particles  moving  in  the  plane.  Figure 
7(a)  illustrates  the  trajectories  of  the  two  vehicles,  and  their  respective  planar 
Frenet-Serret  frames.  The  control  law  specifies  the  steering  commands  U\  and 
U2  for  each  vehicle.  We  present  a  convergence  result  for  the  system  of  two 
vehicles.  In  section  5  we  discuss  the  physical  interpretation  and  motivation  for 
the  control  law. 


Our  model  for  the  pair  of  vehicles  and  associated  feedback  control  law  is  the 
following: 
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r!=xi,  r2=x2, 

xi=yiMi,  x2=y2w2, 

yi  =  -X!Wi,  y  2  = -x2m2, 

“1  =  -v(\r\)  ^1^1  •  Xi  j  i^j-  •  yi  j  -  /  (|r|)  i^j-  •  yi  j  +  //(|r|)x2  •  yu 

«2  =  -v(\*\)  •  x2^  (j^  ( I r I )  (j^  •  y2^)  +  Mlrl)xi  •  y2,  (2) 

where  r  =  r2  —  17,  the  functions  rj(-),  p(-),  and  /(•)  are  Lipschitz  continuous, 
and  /(•)  satisfies 


lim  f{p)  =  -oo, 

p^O 

rp 

lim  J  f{p)dp  =  oo,  for  some  p  >  0.  (3) 

We  further  assume  that  r/(|r|)  >  0  and  /0|r|)  >  0  for  all  |r|  >  0. 

Identifying  (punctured)  R2  with  the  (punctured)  complex  plane,  we  define 


r  =  r2  —  17  =  |rpe 
xi  =  et(h , 
x2  =  e*02 , 

01  =  01  -0, 

0 2  =  02  -0, 


(4) 


where  we  note  that  0  +  f  is  the  argument  (i.e. ,  angle)  of  r.  We  introduce  the 
variable 

P  =  |r|,  (5) 

and  we  observe  that 


■pj-  •  xi  =  Re  jie^’  (e*01)  j  =  sin(0i  —  0)  =  sin0i, 

77  •  x2  =  sin  02, 

|  r  | 

•  yi  =  Re  |ie*^  |  =  cos(0i  —  0)  =  cos0i 

r 

—  •  y2  =  COS  02.  (6) 

|r| 

Figure  7(b)  illustrates  the  definitions  of  p,  0i,  and  02. 

Using 

r  =  ie^|r|  -  |r|e^0  =  x2  -  Xi  =  e*02  -  ei01,  (7) 
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(a)  (b) 

Fig.  7.  Planar  trajectories  for  two  vehicles  and  their  respective  planar  Frenet-Serret 
frames:  (a)  in  (ri,xi,yi),  (r2,X2,y2)  coordinates,  and  (b)  in  (p,  0 1,(^2)  coordinates. 

we  find  that 

p  =  sin  0 2  —  sin  0i , 

Ip  — - (cOS02  —  COS0i)  .  (8) 

p 

We  also  have 

9i—ui  =  —T](p)  sin  01  cos  01  +  f(p)  cos0i  +  p(p)  sin(02  -  #i), 

02  =  u2  =  —r) (p)  sin  02  cos  02  -  f(p)  cos 02  +  p(p)  sin(6li  -  02).  (9) 

We  thus  obtain  the  system 
p  —  sin  02  —  sin  0i, 

0i  =  —pip)  sin  0i  cos  0i  +  f(p)  cos  0i  +  pip)  sin(02  —  0i)  +  -  (cos02  -  cos0i) , 

P 

02  =  —pip)  sill  02  COS  02  -  f(p)  COS  02  +  p{p)  sill(0i  -  02 )  +  “  (COS  02  -  COS0i)  . 

P 

(10) 

System  (10)  represents  a  reduction  of  the  dynamics  (2)  by  the  symmetry  group 
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SE( 2),  which  is  made  possible  by  the  fact  that  the  control  law  of  equation  (2) 
depends  only  on  suitably  defined  shape  variables,  i.e.,  it  is  invariant  under  an 
action  of  the  symmetry  group  SE(2).  This  point  of  view  is  made  precise  and 
further  explored  in  section  7. 

Consider  the  Lyapunov  function  candidate 

Vpair  =  -  In  (cos(02  ~  00  +  1)  +  Kp),  (11) 

where  /(p)  =  dh/ dp.  Differentiating  Vpair  with  respect  to  time  along  (10)  gives 


T>  sin (02  -  0 

PalV  COs(02  -  0i)  +  1 


rxvrr  ~  *) + 

sin (02  -  0i 


COs(02  -  0l)  +  1 


-  7](p)  (sin  02  cos  02  -  sin  01  cos0i)  +  2 /i(p)  sin(0i  -  02) 

-f(p)  (cos  02  +  COS  01 


+/(p)  (sin  02  -  sin  0i ) 

-1 


COs(02  -  0l)  +  1 


sin (02  -  0i )  \  2p(p)  sin (02  -  0i)  +  (sin202  -  sin  200 j 

+/(p)  Sin (02  -  0l)  (COS  02  +  COS00 
~f(p)( cos(02  -  0i )  +  1) (sin 02  -  sin 0i ) 


-1 


COs(02  -  00  +  1 


(  v(p)  N 

sin (02  -  00  I  2 p(p)  sin(02  -  00  H - —  (sin  202  -  sin  200 


(12) 


where  we  have  used  the  identity  (see  Appendix  A) 
sin(02  -  0i ) (cos 02  +  cos 00  -  (cos(02  -  00  +  l)(siii02  -  sin 00  =  0.  (13) 
We  also  have  the  identity  (see  Appendix  A) 


sin (02  -  00  (  sin (02  -  00  +  -(sin202  -  sin  200 


(cos  0i  +  cos02)2(sin0i  —  sin02)2  +  (sin2  0i  —  sin2 


(14) 


Therefore,  provided  2/i(p)  >  p(p),  Vp  >  0,  it  follows  that  Vparr  <  0,  and 
Vpair  =  0  if  and  only  if  sin(02  —  0i)  =  0.  We  can  use  this  calculation  to  prove 
a  convergence  result. 
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Proposition  1:  Consider  the  system  given  by  equation  (10),  evolving  on 
It  x  T2,  where  T2  is  the  two-torus  (i.e.,  0*  +  2n  is  identified  with  0j,  i  =  1,  2). 
In  addition,  assume  the  following: 


(1)  p(p),  p(p),  and  /(p)  are  Lipschitz  continuous  on  (0,  oo) ; 

(2)  /(p)  =  dh/dp ,  so  that  h(p)  is  continuously  differentiable  on  (0,  oo); 

(3)  limp^o  h{p)  =  oo,  lim^oo  h(p)  =  oo,  and  dp  such  that  h(p)  =  0; 

(4)  v(p)  >  0,  p(p)  >  0,  and  2 p(p)  >  rj(p),  Vp  >  0. 


Define  the  set  A  =  <  (p,  0i,  02) 


|0i  —  02 1  ^  and  0  <  p  <  oo  >.  Then  any  tra¬ 


jectory  starting  in  A  converges  to  the  set  of  equilibrium  points  for  system 

(10). 


Proof:  Observe  that  Vpair  given  by  equation  (11)  is  continuously  differentiable 
on  A.  By  assumption  (2)  and  the  form  of  Vpair,  we  conclude  that  Vpair  is 
radially  unbounded  (i.e.,  Vpair  — >  oo  as  |0i  —  02|  — >  7T,  as  p  — >  0,  or  as 
p  — >  oo).  Therefore,  for  each  trajectory  starting  in  A  there  exists  a  compact 
sublevel  set  of  Vpair  such  that  the  trajectory  remains  in  D  for  all  future  time. 
Then  by  LaSalle’s  Invariance  Principle,  the  trajectory  converges  to  the  largest 
invariant  set  M  of  the  set  E  of  all  points  in  D  where  Vpair  =  0  [3].  The  set  E 
in  this  case  is  the  set  of  all  points  (p,  0i,  02)  G  D  such  that  sin(0i  —  <p2 )  =  0, 
i.e.,  such  that  (pi  =  (p2  (since  O  C  A).  At  points  in  E,  the  dynamics  may  be 
expressed  as 


P  =  0, 

0i  =  ~[v(p)  sin0i  +  f(p)\  cos  0i, 

02  =  —  [p(p)  sin  (pi  -/(p)]  cos  0i.  (15) 


If  0i  7^  ±7t/2  and  /(p)  ^  0,  then  the  trajectory  leaves  E.  The  largest  invariant 
set  contained  in  E  may  thus  be  expressed  as 


M=  Vp}  u  Vpj  U  |(pe,0,0) 

which  is  simply  the  set  of  equilibria  of  the  system  (10)  contained  in  D.  □ 


f(pe )  =  ojj  no, 
(16) 


A  physical  interpretation  of  this  convergence  result  (and  the  set  M )  is  provided 
in  subsection  5.4. 
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4-2  Control  law  for  a  single  vehicle  (and  fixed  beacon) 


We  now  present  a  control  law  for  a  single  vehicle  based  on  its  position  and 
orientation  relative  to  a  “beacon1'  fixed  at  the  origin,  as  illustrated  in  figure 
8(a): 


r  =  x, 
x  =  y  u, 
y  =  -xw, 

u = (r  ' x)  (r  ' y)  _  (r  ' y)  •  (17) 

Dehne 


P  =  I r  u 

<f>=e-^.  (is) 

(The  variables  p  and  <f>  are  illustrated  in  figure  8(b).)  Then  we  obtain,  analo¬ 
gously  to  system  (10), 


p  =  smcp, 


0—  ~rj(p)  sin<^c„s</>  —  (/(p)  —  -J  c„s0. 
Consider  the  Lyapunov  function  candidate 

V single  =  “  lll(cOS0)  +  h(p), 

defined  on  the  set 


7T  ,  7T 

P>0, 


A. single  (p?  0) 

and  where  f(p)  —  1/p  =  dh/dp.  We  then  compute 


(19) 


(20) 


(21) 


Sill  (p 
COS  0 


-r)(p)  sin  0  cos  0  —  f/(p) - \  cos0 


+  \  f(p)  ~  -  j  sin. 


=  — p(p)  sin2  (j). 


(22) 
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Fig.  8.  Planar  trajectory  and  Frenet-Serret  frame  for  a  single  vehicle  responding  to 
a  fixed  beacon:  (a)  in  (r,x,y)  coordinates,  and  (b)  in  (p,  0)  coordinates. 

Based  on  this  calculation,  we  can  prove  a  convergence  result. 


Proposition  2:  Consider  the  system  given  by  equation  (19),  evolving  on 
IR  x  T1,  where  T1  is  the  one-torus  (i.e.,  (j)  +  2n  is  identified  with  0).  In  addition, 
assume  the  following: 

(1)  p(p)  and  /(p)  are  Lipschitz  continuous  on  (0,  oo); 

(2)  /(p)  =  dh/dp,  so  that  h(p )  is  continuously  differentiable  on  (0,  cxd)  ; 

(3)  limp^o  h{p)  =  oo,  lim^oo  h(p)  =  oo  and  3p  such  that  h(p)  =  0; 

(4)  rj(p)  >0,  Vp  >  0. 

Let  A single  be  defined  by  equation  (21).  Then  any  trajectory  starting  in  Asingie 
converges  to  the  set  of  equilibrium  points  for  system  (10),  i.e.,  the  set 

^  =  0,  0  =  0  j  .  (23) 


re  =  (p,  0) 


f(p) 


Proof:  Observe  that  Vsingie  given  by  equation  (20)  is  continuously  differen¬ 
tiable  on  Asingie.  By  assumption  (2)  and  the  form  of  Vsingiei  we  conclude  that 
Vsingie  is  radially  unbounded  (i.e.,  VSingie  — >  oo  as  |0|  — >  as  p  — >  0,  or  as 
p  — >  ex:).  Therefore,  for  each  trajectory  starting  in  Asvngie  there  exists  a  com¬ 
pact  sublevel  set  of  Vsmgie  such  that  the  trajectory  remains  in  for  all  future 
time.  Then  by  LaSalle’s  Invariance  Principle,  the  trajectory  converges  to  the 
largest  invariant  set  M  of  the  set  E  of  all  points  in  0  where  VSingie  =  0  [3]. 
The  set  E  in  this  case  is  the  set  of  all  points  (p,  0)  6  O  such  that  sin(0)  =  0, 
i.e.,  such  that  0  =  0  (since  C  A  single)-  At  points  in  E ,  the  dynamics  may  be 
expressed  as 

P  =  o, 

<#>=-(/(p)-l).  (24) 
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If  (f(p)  ~  7^  0,  then  the  trajectory  leaves  E.  The  largest  invariant  set 

contained  in  E  may  thus  be  expressed  as 


M  =  renfi, 


(25) 


which  is  simply  the  set  of  equilibria  of  the  system  (19)  contained  in  Q.  □ 


Remark:  If  the  set  Te  consists  of  isolated  points,  then  Proposition  2  implies 
that  each  trajectory  starting  in  Asingie  converges  to  an  equilibrium  point.  □ 


Remark:  A  result  analogous  to  Proposition  2  holds  for  trajectories  starting 
in 


a  alt  _ 

^single 


p  >  o, 


(26) 


Instead  of  Vsingie  defined  by  equation  (20),  the  Lyapunov  function 


V*ngle  =  ~  ln(“  COS  4>)  +  Kp) 


(27) 


is  used.  □ 


5  Physical  motivation  for  the  planar  control  law 


In  this  section  we  provide  some  physical  motivation  for  the  control  law  ana¬ 
lyzed  in  the  previous  section,  as  well  as  a  physical  interpretation  of  the  conver¬ 
gence  result.  The  objective  is  primarily  to  suggest  why  this  control  law  is  the 
simplest  that  could  reasonably  be  expected  to  perform  well.  (While  the  pur¬ 
pose  of  the  previous  section  was  to  provide  careful  mathematical  statements, 
here  we  adopt  a  more  pragmatic  approach  for  purposes  of  conveying  physical 
intuition.) 


5.1  Achieving  a  common  orientation 


In  system  (2),  the  term  /x(|r|)x2  ■  yi  in  the  equation  for  u \ ,  and  the  term 
/x(|r |)x!  -y2  in  the  equation  for  u2,  can  be  easily  interpreted  as  serving  to  drive 
the  two  vehicles  to  a  common  orientation.  In  fact,  this  approach  generalizes 
for  driving  n  vehicles  to  a  common  orientation.  For  p  >  0  constant,  consider 
the  control  law 
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(28) 


r.  x. 

i/c  y  k'U'k') 

Yk  ^-k^ki 
n 

uk  =  n^T*j  y k, 


3+k 


for  k  —  1, n.  Observe  that  rk  =  xfc  decouples  from  the  rest  of  equation  (28). 
Introducing  complex  notation,  we  define 

(29) 

so  that  the  dynamics  can  be  written  in  9j  coordinates  as 


x  -  =  eidj 

*-3  c  5 


Oj  =  Uj  =  Re  je*0fc  'j  |  =  p  ^  sin(#fc  —  9j 
k^j  k^j 


(30) 


It  is  well  known  that  system  (30)  is  a  gradient  system  with  respect  to  the 
energy  function 

/i 


R orient  ^  )  COS (dfc  0 j  ) , 

2  j,fc 


i.e., 


d,= 


av: 


orient 


an 


(31) 


(32) 


The  control  law  (28)  thus  acts  to  reorient  the  vehicles  so  that  they  all  head 
in  the  same  direction.  Furthermore,  the  heading  direction  for  the  formation 
is  determined  by  an  averaging-like  process  based  on  the  initial  orientations. 
While  these  are  both  laudable  properties,  there  is  a  weakness  to  this  control 
scheme,  as  it  stands,  for  formation  initiation:  there  is  no  control  of  the  relative 
positions  of  the  vehicles  in  the  formation.  We  would  like  to  augment  this 
reorientation  scheme  with  some  approach  for  maintaining  swarm  cohesiveness, 
while  avoiding  collisions. 


5.2  Achieving  appropriate  separation 


To  understand  how  an  appropriate  vehicle  separation  is  maintained  by  system 
(2),  it  is  helpful  to  first  consider  the  single- vehicle  system  given  by  equation 
(17).  Suppose  for  simplicity  that  there  exists  a  single  value  pQ  >  0  such  that 
( f(p0 )  —  l/Po)  —  0.  Then  under  the  assumptions  of  Proposition  2,  for  almost 
all  initial  conditions  (i.e.,  provided  \<f>\  ^  |  initially),  system  (19)  converges 
to  one  of  two  equilibrium  points:  either  (po,0)  or  (p0,7r).  The  corresponding 
solutions  for  system  (17)  are  circular  orbits  centered  at  the  origin  and  with 
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radius  pQ,  and  the  two  (relative)  equilibria  correspond  to  clockwise  and  coun¬ 
terclockwise  orbits.  The  initial  condition  determines  whether  the  orbit  will  be 
clockwise  or  counterclockwise,  and  the  initial  condition  \(f>\  =  |  represents  the 
vehicle  heading  directly  toward  (or  directly  away  from)  the  origin. 

Now  consider  the  control  law  given  by  equation  (2),  but  with  /j  =  0.  Physically, 
this  control  law  can  be  thought  of  as  each  vehicle  using  the  control  law  given 
by  equation  (17),  but  with  the  other  vehicle  treated  as  the  “beacon,”  rather 
than  having  a  beacon  fixed  at  the  origin.  (Due  to  space  limitations,  we  do  not 
provide  any  analytic  statements  for  this  system,  so  this  discussion  is  informal.) 
This  control  law  tends  to  appropriately  separate  the  two  vehicles;  however, 
depending  on  initial  conditions,  they  may  either  head  off  in  the  same  direction, 
or  else  circle  each  other.  Either  of  these  behaviors  is  consistent  with  the  beacon- 
circling  behavior  of  a  single  vehicle  governed  by  the  control  law  of  system  (17). 

We  can  thus  understand  physically  the  various  control  law  terms  in  system 
(2)  for  a  pair  of  vehicles  as  serving  to  achieve  a  common  orientation  and  an 
appropriate  separation.  This  physical  interpretation  is  compatible  with  many 
biological  swarming  and  schooling  models,  which  tend  to  be  characterized  by 
(1)  some  mechanism  for  heading  alignment,  (2)  switching  between  attraction 
or  repulsion  based  on  separation  distance,  and  (3)  greater  responsiveness  for 
small  separations  [13]. 


5.3  Angle  quantities  appearing  in  the  control  law 


In  the  control  law  for  a  pair  of  vehicles,  system  (2),  various  dot  products  (rep¬ 
resenting  sines  and  cosines  of  various  angles)  appear.  The  quantities  j 

and  •  y^j  in  the  expression  for  rq,  i  =  1,2,  indicate  the  orientation  of  the 
•th 

r11  vehicle  relative  to  the  baseline  between  the  two  vehicles.  These  are  the 
angle-of- arrival  quantities  that  can  be  sensed  from  a  single  transmitted  tone 
using  the  two  pairs  of  antennas  shown  in  figure  2.  (Note  that  these  are  the 
only  angle  quantities  required  for  the  single  vehicle  control  law,  system  (17).) 

The  quantities  x2  ■  yi  and  xi  ■  y2  can  be  expressed  as 


(33) 


Thus,  the  relative  orientation  between  the  two  vehicles  can  be  determined 
from  the  relative  orientations  of  each  vehicle  relative  to  the  baseline  between 
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them.  For  our  implementation  approach  based  on  radio-frequency  pulses,  the 
orientation  of  a  transmitting  UAV  relative  to  the  baseline  between  the  UAVs 
is  sensed  with  the  aid  of  the  four  cardioid  transmit  antenna  patterns  of  figure 
3(d), 


5-4  Interpretation  of  the  convergence  result 


Consider  the  control  law  for  a  pair  of  vehicles  given  by  system  (2).  Suppose 
for  simplicity  that  there  exists  a  single  value  pQ  >  0  such  that  f(p0)  =  0.  Then 
the  set  of  equilibria  which  system  (10)  can  converge  to  consists  of  the  isolated 
point  (p0, 0,  0),  the  connected  set  (p,  |,  |),  and  the  connected  set  (p,  —  |,  —  |). 
The  isolated  point  (po,0,0)  is  easily  interpreted:  both  vehicles  are  heading  in 
the  same  direction,  perpendicular  to  the  baseline  between  them,  and  separated 
by  a  distance  pQ.  This  stable  equilibrium  minimizes  Vpair.  The  other  sets  of 
equilibria  correspond  to  the  two  vehicles  heading  in  the  same  direction,  one 
leading  the  other  by  a  distance  p  (with  the  two  sets  distinguished  by  which 
vehicle  is  in  the  lead).  These  equilibria  appear  to  be  unstable. 

The  requirements  on  /(•)  for  Proposition  1  to  hold,  namely 


/(p)  is  (Lipschitz)  continuous  on  (0,  00), 
f{p)  =  ^  with  h(p)  =  0, 
fp 

lim  h{p)  =  lim  /  f(p)dp  =  00, 


p— KX) 


p— >00 


CP 

lini  h(p)  =  lim  /  f(p)dp  =  00, 

P^O  p^O  Jp 


(34) 

(35) 


have  some  practical  implications.  For  example,  if  /(p)  ~  I  as  p  — >  00,  then 
equation  (34)  holds;  however,  if  /(p)  «  as  p  — >  00,  then  it  does  not.  If 
/(p)  is  derived  from  a  physical  measurement  of  received  signal  power  from 
another  UAV,  then  it  would  be  natural  for  /(p)  «  jp  as  p  — >  00.  This  means 
our  model  of  the  physical  system,  for  which  Proposition  1  holds,  can  only 
be  valid  provided  the  distance  between  the  UAVs  is  not  too  large. 


Equation  (35)  implies  /(p)  — >  —  00  as  p  — »  0.  Physically,  this  suggests  that  the 
steering  control  for  the  vehicles  can  become  infinite  if  the  separation  between 
the  vehicles  is  small.  Thus,  our  model  of  the  system  is  only  valid  provided  the 
vehicles  remain  sufficiently  far  apart.  Although  our  model  can  only  be  valid 
for  a  certain  range  of  distances  between  the  vehicles,  from  Proposition  1  we 
know  that  for  our  model,  trajectories  never  leave  sublevel  sets  of  Vpair.  Thus, 
as  long  as  the  two  vehicles  satisfy  initial  conditions  within  a  sublevel  set  of 
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Vpair,  throughout  which  the  model  agrees  with  the  physical  system,  then  the 
conclusion  of  Proposition  1  remains  valid. 


6  A  generalization  of  the  planar  control  law  to  n  vehicles 

The  control  system  given  by  equation  (2)  can  be  generalized  to  n  vehicles  as 
follows: 

rfc=xfc, 

Xfc  y  k^kt 

y  fc  =  -xfeUfc,  (36) 


with 


where  r ^  =  r/,:  —  vj.  One  possible  choice  for  /(•)  is 


/(M)=«  l-frrr)  ,  (38) 

V  \rjk\J 

and  n,  rj,  and  a  could  also  be  functions  of  inter-vehicle  distance.  Observe  that 
each  vehicle  trajectory  evolves  with  its  own  planar  Frenet-Serret  equation,  and 
that  the  control  is  simply  a  sum  of  terms  analogous  to  those  present  in  system 
(2). 

A  generalization  of  the  energy  function  Vpair  that  might  play  a  role  in  analyzing 
the  convergence  of  this  system  is 

n 

=  wjk  [-  ln  (cos(^  -  9j)  +  1)  +  h(pjk)] ,  (39) 

k= 1 j<k 

where  the  Wjk  are  positive  weights  (or  weighting  functions).  We  have  not  yet 
proved  a  convergence  result  for  the  n- vehicle  system.  However,  simulation 
results,  combined  with  Proposition  1,  suggests  that  it  may  be  possible  to 
prove  some  sort  of  convergence  result  for  the  n- vehicle  system. 

Figure  9  shows  the  formation-initializing  behavior  for  three  different  sets  of 
random  initial  conditions.  Observe  that  the  ultimate  heading  direction  for 
the  formation  is  initial-condition  dependent.  Also,  observe  that  the  relative 
positions  of  the  vehicles  within  the  formation  is  somewhat  irregular,  although 
the  spacings  between  neighbors  are  roughly  consistent.  It  appears  from  the 
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Fig.  9.  Formation  initialization  for  ten  vehicles  with  three  different  sets  of  random 
initial  conditions  (in  equations  (36)  and  (37),  rj  =  n  =  a  =  constant  =  0.02). 


Normalized  Separation  Parameter  vs.  Time 


(b) 


Fig.  10.  Formation  flying  for  ten  vehicles  as  the  separation  parameter  is  varied: 
(a)  the  vehicle  trajectories,  and  (b)  a  semilog  plot  of  the  normalized  separation 
parameter  vs.  time  (where  the  time  axis  is  linear). 

simulation  results  that  the  control  scheme  given  by  equations  (36)  and  (37) 
does  indeed  avoid  collisions  and  maintain  swarm  cohesiveness. 

Figure  10(a)  illustrates  how  a  single  parameter,  common  to  all  the  vehicles,  can 
be  varied  to  produce  a  global  change  in  the  formation.  For  this  simulation, 
the  length  scale  parameter  (or  separation  parameter)  a  in  equation  (38)  is 
varied  with  time  as  shown  in  figure  10(b).  As  a  is  decreased,  the  formation 
becomes  more  tight,  and  as  a  is  increased,  the  separation  between  the  vehicles 
increases. 

Figure  11  illustrates  “leader-following”  behavior.  The  leader,  i.e.,  the  vehicle 
represented  by  the  dashed  path,  follows  a  prescribed  steering  program,  and 
is  unaffected  by  the  other  vehicles.  However,  the  other  vehicles  are  influenced 
both  by  the  leader  and  by  each  other.  (Results  are  shown  for  two  different 
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Fig.  11.  Formation  initialization  for  ten  vehicles,  one  of  which  (dashed)  follows  a 
prescribed  steering  program  unaffected  by  the  other  vehicles  (for  two  different  sets 
of  random  initial  conditions). 

sets  of  random  initial  conditions.)  The  influence  of  the  leader  on  the  formation 
behavior  is  evident;  however,  the  leader  need  not  be  physically  in  front  of  the 
other  vehicles.  Indeed,  this  is  by  no  means  the  only  approach  for  generating 
leader-following  behavior;  nor  is  it  necessarily  the  best  approach.  However,  it 
clearly  illustrates  the  possibility  of  allowing  the  control  law  of  equations  (36) 
and  (37)  to  maintain  the  basic  formation,  while  some  additional  control  action 
guides  the  formation  as  a  whole. 


7  Lie  group  formulation  and  relative  equilibria 


7. 1  Two-vehicle  problem 


There  is  a  natural  Lie  group  structure  evident  in  system  (2).  In  this  subsec¬ 
tion,  we  discuss  how  the  formation  control  problem  for  two  vehicles  can  be 
formulated  as  a  “shape-control”  problem  in  the  Lie  group  setting  [4-6].  We 
can  consider  the  dynamics  of  system  (2)  as  evolving  on  a  (collision-free)  con¬ 
figuration  submanifold  Mconfig  C  G  x  G,  where  G  =  SE( 2)  is  the  special 
Euclidean  group  in  the  plane.  Specifically,  if  €  G  are  represented  as 


Xl 

yi 

ri 

x2 

y2 

r2 

,9i  = 

0 

0 

l 

,  92  = 

0 

0 

1 

(40) 
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then 


Mconfig  -  |  (31,92)  6  G  x  G 


rl  7^  r2 


(41) 


(From  Proposition  1,  we  can  conclude  that  for  initial  conditions  in  Mconfig, 
the  dynamics  evolve  in  Mconfig  for  all  future  time,  provided  the  controls  given 
by  equation  (2)  are  used.  However,  for  purposes  of  this  section,  we  are  primar¬ 
ily  interested  in  identifying  relative  equilibria  without  restriction  to  a  partic¬ 
ular  control  law.)  We  can  express  the  dynamics  given  by  equation  (2)  as 


gi=gi£i  =  g\  (H0  +  A^i), 

&2  =  02&J  =  g2  (bio  +  A1U2),  (42) 

where  (1,(2  £§  =  the  Lie  algebra  of  G,  and  the  matrices  Ho  and  A\  (which 
generate  g  under  Lie  bracketing)  are  given  by 


- 1 

0 

0 

_ 1 

1 

O 

-1 

1 

0 

0 

0 

0 

)  Ai  — 

1 

0 

0 

1 - 

0 

0 

1 

0 

1 

O 

0 

1 

0 

(43) 


We  define 

g  =  gi'gn. 


(44) 


and  observe  that 


T 

X1 

— rl  •  x! 

X2 

y2 

r2 

Xi  •  X2 

Xi  •  y2 

(r2 

—  rl) 

•  Xi 

T 

y  1 

— ri  -  yi 

= 

yi  •  x2 

yi  -y2 

(r2 

—  rl) 

■  yi 

0  0 

1 

0 

0 

1 

0 

0 

1 

(45) 


Similarly, 


g  1  =  g2  V 


xi-x2  x2  •  yi  —  (r2  —  iq)  •  x2 
Y2-xi  yi  •  y2  — (r2  —  ri)  •  y2 
0  0  1 


(46) 


Let  gij  denote  the  elements  of  the  matrix  g,  let  g1^  denote  the  elements  of  the 
matrix  g~ x,  and  let 


I-  =  L&  +  &  =  \/(913)2  +  (923)2.  (47) 

We  have  the  following  relationships  among  the  g^  and 
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(48) 


gn  =  g22  =  g11  =  g22, 
si2  =  -02i  =  g2i  =  -g12, 


and 

0H  +  0i2  =  1-  (49) 

Remark:  We  can  express  u  \  and  u2  as  defined  by  equation  (2)  as 

Mg)  =  -v{r)  — )  +  f{r)  +  M)g2i, 

Mg)  =  ~v(r)  +  ttr)  +  M)g21-  (so) 

Equations  (42),  (44),  and  (50)  are  sufficient  to  conclude  that  the  closed-loop 
dynamics  are  (S'- invariant.  Although  we  do  not  require  the  specific  control  law 
given  by  equation  (50)  for  the  (relative)  equilibrium  analysis  presented  in  this 
subsection,  we  do  assume  that  the  control  law  is  (S'-invariant,  in  addition  to 
ensuring  that  the  dynamics  evolve  in  the  collision- free  submanifold.  □ 

Now, 


0 = -0r10i0f102  +  0i_102 
=  -0i_10i60  +  0b1 026 

=  Mi  0  +  06 
=  0(6  -0_160) 

=  0(6  -  Ad9-i6) 

=  0£,  (51) 

where  £  =  £2  —  Ad9-i£i  G  0.  If  the  feedback  controls  depend  only  on  the  shape 
variable  g,  then  £  =  £(<7)  and  (51)  evolves  on  the  shape  space  Mconfig/G. 

We  refer  to  (51)  as  the  reduced  dynamics.  Equilibria  of  the  reduced  dynamics 
correspond  to  relative  equilibria  of  the  full  dynamics  in  Mconfig.  The  equilibria 
ge  of  the  reduced  dynamics  are  given  by  setting 

Me)  =  £2 (0c)  -  0b1£l(0e)0e  =  0.  (52) 

Equation  (52)  is  equivalent  to 

0e£2(0e)  =  £l(0e)0e,  (53) 

which  (dropping  the  “e”  subscript)  becomes 
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9ii 

912 

913 

0  - 

1 

£ 

to 

_ 1 

0  - 

Mi 

1 

9n 

912 

913 

—912 

9ii 

923 

U2 

0 

0 
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Ml 

0 

0 

—912 

9n 

923 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

1 

912^2 

- 

-911M2 

9n 

912M1 

- 

-911M1 

1  —  923M1 

9ll«2 

912M2 

- 

_9l2 

= 

9llMl 

912M1 

913M1 

.  (54 

0 

0 

0 

0 

0 

0 

Since  g\x  +  gj2  =  1,  at  equilibrium  we  must  have 

u2  =  u1, 

9u  —  1  -  <723  W 1, 

9l2  =  — 

But  equation  (52)  is  also  equivalent  to 

6(9e)9e_1  =  9e_16(9e), 

which  (by  an  analogous  computation)  leads  to 
u2  =  u1} 

9u  =  i  -  g23u2, 

gi2  =  g13u2.  (57) 

Using  g ,,  +  <^2  =  U  from  equation  (55)  we  obtain 


(55) 

(56) 


1  =  (1  -  #23«l)2  +  9?3W1 
=  1  -  2^23^1  +  923M1  +  9^1 


0  =  U\ 


(g'\:i  +  923)  Mi  —  2^23 


Mi 


2^23 

9  1  9  5 

.9 13  +  923 


or  u  1  =  0. 


(58) 


There  are  thus  two  distinct  equilibrium  cases  to  analyze:  U\  —  0  and  U\  = 
2923 /t2.  First,  consider  the  case  u  1  =  0.  Then  from  equations  (55)  and  (57), 
we  conclude 


u2  =  ui  =  0 
9n  —  1; 

912  =  0. 
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(59) 


For  such  an  equilibrium,  xi  =  x2,  so  we  also  have 


913  =  -g13, 

923  = -g23-  (60) 

However,  the  relationship  between  xi  and  r  =  r2  —  ri  is  arbitrary. 

Next,  consider  the  case  u i  =  2g2;$/r2  ^  0.  We  must  assume  that  r  >  0  so  that 
U\  is  well-defined.  Then  from  equations  (55)  and  (57),  we  conclude 


u2  =  u1  =  2g23/r2, 

923  =  923, 

9i3  =  -g13i 
9u  =  1  —  2^3  /r 2 , 

9\2  = -2913923 1 r2  ■  (61) 


With  some  further  calculation  (see  Appendix  B),  one  can  show  that  the  corre¬ 
sponding  relative  equilibrium  consists  of  the  two  vehicles  moving  on  the  same 
circular  orbit,  separated  by  a  chord  of  fixed  length. 


The  notion  of  shape  space  associated  to  a  symmetry  group  is  useful  for  de¬ 
scribing  the  evolution  of  system  (42)  [4-6].  To  summarize,  equation  (42)  de¬ 
scribes  motion  in  the  configuration  space.  The  variable  g  =  gxl92  plays  the 
role  of  a  shape  variable,  and  evolves  on  the  (collision-free)  shape  submani¬ 
fold  M shaPe  =  Mconfig/G.  The  reduced  dynamics  on  shape  space  are  given 
by  equation  (51).  Equilibria  ge  of  the  reduced  dynamics  correspond  to  equi¬ 
librium  shapes.  The  configuration  variables  can  be  expressed  in  terms  of  the 
shape  variable  as 

(91,92)  =  (9i,9i9),  (62) 

and  if  g  —  ge  (i.e.,  the  shape  is  an  equilibrium  shape),  then  the  trajectory  in 
the  configuration  space  is  a  relative  equilibrium. 

Remark:  The  collision-free  submanifold  Mshape  is  isomorphic  to  IR  x  T2,  the 
set  which  appears  in  the  statement  of  Proposition  1.  Indeed,  Proposition 
1  can  be  understood  as  a  convergence  result  for  the  shape  dynamics.  □ 

Remark:  The  Lyapunov  function  Vpair  given  by  equation  (11)  is,  as  expected, 
also  (S'- invariant,  and  can  be  expressed  as 


bpair  111 


(9i3913  +  g23923)/r2 


+  h(r).  □ 


(63) 
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7.2  The  n-vehicle  problem 


The  notions  of  configuration  space  and  shape  space  described  above  for  the 
2-vehicle  problem  generalize  naturally  to  n  vehicles.  The  configuration  space 
consists  of  n  copies  of  G  —  SE{ 2),  and  an  appropriate  non-collision  manifold 
analogous  to  Mconfig  can  be  defined.  The  dynamics  in  configuration  variables 
can  be  expressed  as 


.91  =  gi£l,  92  =  .926,  •••  9n  =  9n£n,  (64) 

where  £1,  £2)  •••  Cn  £  0  have  the  form 

=  A0  +  AiUj,  Vj  =  1, ...,  n.  (65) 

We  define  the  shape  variables 

9j  =  9i19j,  j  —  2,  ••.,  n,  (66) 

which  evolve  on  the  reduced  (shape)  space  consisting  of  a  product  of  n  —  1 
copies  of  G.  (It  is  also  possible  to  define  shape  variables  in  other  combina¬ 
tions;  e.g.,  gj  =  gj\gj,  j  =  2 [5].)  Here  we  have  assumed  that  £i,  £2, 
...  depend  only  on  the  reduced  variables  ^2,93,  ■■■9n  (and  we  note  that  this 
assumption  can  indeed  be  verified  for  the  control  law  given  by  equation  (36)). 

By  calculations  analogous  to  those  in  the  previous  subsection,  we  are  led  to 
the  conclusion  that  at  equilibrium  (in  shape  space), 

u\  =  u2  =  ...  =  un.  (67) 

Proposition  3:  Consider  the  dynamics  given  by  equations  (64)  and  (65), 
evolving  on  the  collision-free  submanifold 

n  copies 

f  ' - A - s 

Mconfig  |  •••)  Qn)  G  G  X  G  X  ...  X  G 

(68) 

where  G  =  SE( 2)  (and  r3  is  defined  as  in  equation  (40)  for  j  =  1, 
Assume  that  the  controls  ui,  u2,  ...un  depend  only  on  the  shape  variables  given 
by  equation  (66)  (i.e.,  the  controls  are  (S'- invariant) .  Then  for  equilibrium 
shapes  (i.e.,  for  relative  equilibria  of  the  dynamics  (64)  on  configuration  space) 
U\  =  u2  =  ...  =  un,  and  there  are  only  two  possibilities: 

(a)  Ui  —  u2  —  ...  =  un  —  0  at  equilibrium,  in  which  case  a  relative  equilib¬ 
rium  consists  of  all  vehicles  heading  in  the  same  direction  (with  arbitrary 
relative  positions  within  the  formation),  or 


r jk  =  rfc-ij  ^  0,  1  <j^k<n 


Fig.  12.  Relative  equilibria  for  the  n-vehicle  problem,  illustrated  for  n  =  5  (arrows 
indicate  tangent  vectors  to  the  vehicle  trajectories):  (a)  for  u\  =  it?  =  ...  =  un  =  0, 
and  (b)  for  u\  =  112  =  ...  =  un  7^  0. 

(b)  u\  —  U2  —  ...  =  un  7^  0,  in  which  case  a  relative  equilibrium  consists  of  all 
vehicles  moving  on  the  same  circular  orbit,  with  arbitrary  cordal  distances 
between  them. 

Proof:  Omitted  due  to  space  constraints,  but  essentially  follows  the  same 
steps  indicated  in  the  previous  subsection  for  the  two-vehicle  problem.  □ 

Figure  12  illustrates  the  two  types  of  relative  equilibria  for  the  n-vehicle  prob¬ 
lem  described  in  Proposition  3. 

Thus,  the  control  system  (2),  or  system  (36),  can  be  naturally  understood  in 
the  Lie  group  setting.  This  suggests  that  shape  space  notions  for  Lie  groups 
may  play  an  important  role  in  formation  control  problems.  We  have  shown 
how  to  characterize  the  set  of  all  possible  relative  equilibria  for  any  choice 
of  G-invariant  control  law.  We  are  now  in  the  process  of  investigating  the 
next  obvious  issue:  how  to  choose  controls  that  stabilize  particular  relative 
equilibria. 


8  Conclusions  and  future  research  directions 


Our  work  on  formation  control  using  models  based  on  the  Frenet-Serret  equa¬ 
tions  of  motion  is  still  in  its  early  stages.  Areas  of  current  and  future  work 
include  developing  control  laws  and  proving  stability  results  for  formations  of 
n  vehicles,  investigating  continuum  limits  in  which  the  number  of  “vehicles” 
becomes  infinite,  and  investigating  formation-control  problems  in  the  setting 
of  the  three-dimensional  Frenet-Serret  equations.  On  the  practical  side,  there 
is  also  an  effort  underway  to  develop  the  hardware  required  for  implementation 
of  these  types  of  control  laws  for  meter-scale  UAVs,  and  here  the  development 
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of  the  analog  VLSI  processor  is  one  of  the  main  challenges.  An  essential  theme 
of  this  work  is  that  jointly  considering  control  law  design  and  implementation 
issues  has  the  best  chance  of  ultimately  leading  to  a  prototype  formation  con¬ 
trol  system  implementation  for  meter-scale  UAVs. 
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Appendix  A 


Derivation  of  equation  (13): 

sin (02  -  0l)  (COS  02  +  COS  0i )  -  (cos(02  -  0l)  +  l)(sill02  -  sin  01 ) 

=  (sin  02  COS  01  —  COS  02  sin  0i)  (cos  01  +  COS  02) 

—  (cos  02  cos  0i  +  sin  02  sin  0i)(sin  02  —  sin  0i) 

—  (sin  02  —  sin  0i) 

=  sin  02  cos2  0i  +  sin  02  cos  0i  cos  02  —  sin  0i  cos  0i  cos  02  —  sin  0i  cos2  02 

—  sin  02  cos  0i  cos  02  —  sin2  02  sin  0i  +  sin  0i  cos  0i  cos  02  +  sin2  0i  sin  02 

—  (sin  02  —  sin  0i) 

=  sin  02  —  sin  0i  —  (sin  02  —  sin  0i) 

=  0.  (69) 


Derivation  of  equation  (14): 
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sin (02  -  0i)  (sin(02  -  <f>i)  +  ^(sin202  -  sin  200^ 


=  (sin  02  cos  0i  —  cos  02  sin  00 


(sin  02  cos  0i  —  cos  02  sin  0i) 

+  (sin  02  cos  02  —  cos  0i  sin  0i) 


=  sin2  02  cos2  0i  —  sin  0i  sin  02  cos  0i  cos  02 

—  sin  0i  sin  02  cos  0i  cos  02  +  sin2  0i  cos2 
+  sin2  02  cos  0i  cos  02  —  sin  0i  sin  02  cos2  02 

—  sin  0i  sin  02  cos2  0i  +  sin2  0i  cos  0i  cos  02 
i  cos  02  (sin2  0i  —  2  sin  0i  sin  02  +  sin2  02) 

/i  i  \ 


=  cos  0i  cos  02  (si 

+  cos2  01  Q  sin2  02  -  sin  0i  sin  02  +  ^  sin2  0i 

' 1  1 

’  ~2  *  A  sin  02  H —  sin2 


+  cos^ 


-  sin2  0i  —  sin  0 1 

v2  "  r 


1  2  ,  •  2  ,  1  2,.2 
-  cos  0i  sin  02  —  -  cos  0i  sm  . 

2  A  ;  sin2  0i - cos2  02  sin2  - 


+-c°s 


i  (cos  01  +  cos  02 ) 2  (sin  01  -  sin02)2 

—  cos2  0i^  sin2  0i  +  (cos2  0 1  —  cos2  02)  sin2  02 


+  (cos2  02 

(cos  0i  +  cos  02 ) 2  (sin  0i  —  sin02) 

+  (cos2  02  —  cos2  0i )  (sin2  0 
(cos  0i  +  cos  02 ) 2  (sin  0i  —  sin02)2  +  (sin2  0i 


-  sin2 


Sill  02 


,(70) 


Appendix  B 


Here  we  show  that  the  equilibrium  equation  (61),  for  g2 3  7^  0,  implies  that 
the  corresponding  relative  equilibrium  consists  of  the  two  vehicles  moving  on 
the  circular  orbit,  separated  by  a  chord  of  fixed  length.  The  first  observation 
is  that  because  u\  —  u2  —  constant,  both  vehicles  traverse  circular  orbits  of 


32 


radius  1/|mi|.  For  the  first  vehicle,  we  define 


Q 1 


xi  yi 


G  SO{ 2), 


(71) 


so  that 

0  —Mi 

Ml  0 

which  can  be  integrated  with  respect  to  time  to  give 


Qi  —  Qi 


(72) 


Qi(t)  =  Qi(o) 


cos(Mit)  —  sin(Mit) 
sin(Mit)  cos(Mit) 


(73) 


The  equation  for  iq,  the  position  of  the  hrst  vehicle  as  a  function  of  time, 
becomes 


*i  =  Qi(0) 


COs(Mit) 
sin(Mif) 

which  can  be  integrated  with  respect  to  time  to  give 


(74) 


ri  (t)  =  — Qi(0) 

Mi 


sin(Mif) 

^  —  cos(Mif)J 


+  ci 


(75) 


where  Ci  is  a  constant  vector.  We  thus  obtain 


2 

1 

sin(Mif) 

ri(t) - Qi(o)ci 

= 

—Qi  0 

Mi 

Mi 

1 

J) 

03 

O 

O 

1 

_ 1 

1 


2  5 

Ml 


(76) 


which  shows  that  the  trajectory  of  the  hrst  vehicle  lies  on  a  circle  of  radius 
1/|mi|  centered  at  (1/mi)Qi(0)ci.  Futhcrmore, 


ri(0)  =  — Qi(0) 

Mi 


0 

-1 


+  Ci  . 


(77) 


The  corresponding  calculation  for  the  second  vehicle  gives 

/I 


r2(0)  =  —^2(0) 

Mi 


VL 


0 


+  c2 


(78) 


33 


A  relationship  between  (q  and  c2  arises  from  the  formula  /72(f)  =  g\(t)g,  where 


1  —  .92.3  —  9i3^i  .9 13 

9  —  gvzUi  1  —  .923^1  923 

0  0  1 

is  the  equilibrium  shape.  For  convenience,  we  denote 

r  q  b  1 

9  = 

Loo  1 J 

and  from  g2{t)  =  gi(t)g,  it  follows  that 

Q2(t)  =  Qi(t)Q, 

r2(t)=Qi(t)h  +  ri(i). 

Then 


(79) 


(80) 


(81) 
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b  = 


Q  = 


9 13 
923 

1  —  .92.3 M 1  — ^713^1 

913^1  1  —  923u1 

to  observe  that 


1 

0 

1 

0 

b  -| - 

=  -Q 

u  1 

-1 

Ui 

-1 

Combining  equations  (84)  and  (86)  then  gives 

ci  =  Qc2. 


(85) 


(86) 


(87) 


The  center  of  the  circular  orbit  for  the  first  vehicle  was  shown  above  to  be 
(l/ni)<5i(0)c1,  and  likewise,  the  center  of  the  circular  orbit  for  the  second 
vehicle  is 

-Q2(o)c2  =  lg1(o)gC2  =  — Q!(o)Cl.  (88) 

U 1  U\  III 

Thus,  the  two  vehicle  trajectories  traverse  the  same  circle. 


Note  that  the  chordal  distance  between  the  vehicles  is  given  by 

r  =  \AlS  +  923, 

but  the  diameter  of  the  circular  trajectory  is 

7  _  -  _  9l3  +  9 23 

1 923 1  ' 

Thus,  d  —  r  if  and  only  if  g  13  =  0. 


(89) 


(90) 
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